#include "DJI/M3508.h"

#include <thread>

int main() {
    const auto m3508 = std::make_unique<MM::M3508s>("can0", "test", true, false);
    m3508->enable<MM::EnablePlotting>();
    m3508->velControl({1080});
    std::this_thread::sleep_for(std::chrono::seconds(5));
    m3508->stop();
    std::this_thread::sleep_for(std::chrono::seconds(2));
    m3508->PIDCalibration<MM::CurrentLoop, MM::SineFunc>(1);
    std::this_thread::sleep_for(
        std::chrono::seconds(2));
    return EXIT_SUCCESS;
}
